https://www.passeidireto.com/pergunta/133023265/no-mcu-os-modulos-das-velocidades-angular-e-linear-sao-constantes-ja-a-direcao-d
Recomendo esse arquivo que achei no Passei Direto